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1. INTRODUCTION 

There are many advantages of controlling multiple mobile robots. For achieving a task, which might 
require one sophisticated and expensive robot, a group of simple robots can be sufficient [1]. Using multiple 
robots can also contribute to the robustness and the efficiency of the system formed by robots [2], [3]. 
The applications are widespread and range from automated highway systems [4], [5] to achieving formations 
with satellites [6]. 

This paper considers the implementation of formation controllers in a leader/follower manner on 
given mobile robots. The appearance of one mobile robot can be seen in Figure 1. This robot is driven by two 
independently actuated motors in differential drive mode. For measuring the position and the orientation of 
the robot, encoders are attached to each motor and measure the displacement of each wheel. Furthermore, 
position sensitive devices (PSD) are installed which measure the distance to an object. These PSDs are 
mounted in front and on the side of the robot. The hardware in terms of computational ability is divided into 
two parts. The high level is a Raspberry Pi board which is designed to run the application program and 
the low level is an Arduino which request data of the sensors and drive the actuators. 

The remainder of this paper is organized as follows: in section 2, a literature review about formation 
control is given. Especially, the different tasks to achieve with mobile robots are emphasized. Section 3 deals 
with models of a mobile robot. Firstly, a kinematic model is presented. Secondly, a complex dynamic model 
is introduced. This model is reduced afterwards and the parameters are identified. Finally, a speed controller 
is designed based on the identified model. In Section 4, two formation controllers based on a leader/follower 
approach are presented. Furthermore, a collision avoidance controller is proposed based on a leader/follower 
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approach. This Section is followed by simulation investigations in Section 5. Therefore, considered models 
for these simulation investigations are introduced. Based on these models, simulations for each of 
the three presented formation controller of Section 4 are performed. The experimental results of each 
considered formation controller are shown in Section 6. Section 7 gives a conclusion as well as an outlook on 
further work. 





Figure 1. Appearance of the mobile robot 


2. LITERATURE REVIEW 

There are several control tasks to achieve with mobile robots. The most basic task is to follow a 
given trajectory [7], known as trajectory tracking. Another motion task is to achieve group formation. 
Thereby, the goal is to change the position of each robot in order to generate a group formation [8]. 
This formation control could be considered as an extension to the trajectory tracking problem where robots 
follow a given trajectory while performing a formation. 

The trajectory tracking problem was solved in [9] by using a time-varying control law as a feedback. 
Another way to solve this problem is through the use of dynamic feedback linearization [10], [11] and [12]. 
In [13] and [14] the technique of backstepping is used for trajectory tracking of nonholonomic systems. 
The approach in [15] takes advantage of the cascade structure of the robot model. 

The group formation control is considered as a control law which controls the mobile robots in a 
certain formation. In [16], the authors proposed an approach to achieve this goal by a time-varying feedback 
control. Zhiyun et al. give necessary and sufficient graphical conditions for the formation stabilization to a 
point and to more general geometric pattern [17]. 

There are various approaches to formation tracking, like the behavior-based method [18], the virtual 
structure strategy [19] and the leader-follower approach [20], [21] and [22]. The behavior-based approach 
defines a desired behavior for each robot. In order to derive the control law, the relative importance of each 
behavior is weighted [23]. This approach is used, for example, to apply the social characteristics of insects 
and animals to multirobot systems [24]. The virtual structure method treats the entire formation as a single 
entity. To derive the control law for each robot, the motion of the virtual structure is considered and 
transformed into the motion of the robot [25] and [26]. 

In this paper, we focus on the leader-follower approach. To accomplish the leader-follower strategy 
there are several approaches. Lei and Antsaklis made use of the cascade approach as in [15] to achieve a 
consensus-based controller [27]. Desai et al. applied feedback linearization to exponentially stabilize 
the distance and the orientation between the leader and the follower [20]. In addition to these approaches, 
model predictive control (MPC) has become an accepted method in solving the formation control problem. 
In [28], a nonlinear MPC is applied. Since the computational e ort is higher than applying a linear MPC, 
Kamel and Youmin use a linear MPC in combination with an input-output feedback linearization to achieve a 
leader-follower formation control [29]. 

Related works, where an implementation of a formation controller takes place are [30], [31], [32] 
and [33]. In these papers simulation results of the formation controller are presented. However, none of them 
considers a dynamic model, uncertainties of the sensors or the communication structure. Therefore, 
this work takes an extended model of the robot into account and performs further simulations. In Figure 2 is 
the considered robot with the relevant parameters. 
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Figure 2. This Figure shows the considered robot with the relevant parameters 


3. MODEL SETUP 

In this section, a kinematic and a dynamic model is introduced. The kinematic model describes 
the motion of the mobile robot with the velocity and angular velocity as an input. This model is used for 
the controller design. Opposed to the kinematic model, the dynamic model describes the motion of 
the mobile robot based on the acting forces. The dynamic model is too detailed to use for the controller 
design but it can be used to validate the designed controller. 


3.1. Kinematic model 

In this work, differentially driven wheeled mobile robots are considered. Each robot has two wheels 
that can be actuated independently. The description of a robot in a two-dimensional space can be done by 
the current position (x; y) and the orientation angle $, Hence, the state vector results to 


ait) = (zit). v(t); Alt) -The kinematic equations of the robot are represented in Equation (1), 


# = vcos(¢) 
y = vsin(®) 
FE 
r(0) = zo, y(0) = yo, (0) = oo, (1) 


. . l . a SP > . 
with the velocity v and the angular velocity “ as an input “ = v.!|" The connectedness of the velocity 


(Ww,R, Ww.) is given by 


and angular velocity of the robot to the angular velocity of both wheels 
es puw.E t Gwe 
2 
yp MR Sw 
j 2 


with r being the radius of a wheel. 


3.2. Dynamic model 
3.2.1. Unreduced model 

The geometric parameters of a mobile robot are shown in Figure 2 where B is the wheel baseline 
center, G is the center of gravity, C is the position of the castor, L is the position of the left wheel and R is 
the position of the right wheel. The geometric distances are expressed by b, c and d. 

The dynamic model of a robot is derived in [34]. The full dynamic equations of [34] are given in 


T 
Equation (3), where m is the mass of the robot. The uncertainty vector i= [és dy: 0, fus 5s] includes the slip 
speed of the wheels, the viscous friction forces and the resistance force of the castor. The input of the model 
is given by ‘*dan’. 
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Equation (3) and Equation (4) according to [34], where R, is the nominal radius of the tire, Ze is the moment 
of inertia of the combined motor rotor and wheel, Z is the moment of inertia of the robot about the vertical 
axis, k is the motor torque constant and iz and ig are the motor currents of the left and the right motors. 


3.2.2. Reduced model 

The model in (3) has an uncertainty vector which is difficult to identify. This motivates some 
simplifications to get a reduced dynamic model. As a first simplification, the uncertainty vector 6 in 
Equation (3) will be neglected. This can be done by the assumption of no slipping wheels, no external 
disturbance and by neglecting the friction of the castor. 

Furthermore, the input signal of the motor is the duty cycle of the pulse-width modulation (PWM) 
signal. Since the model in Equation (3) is using the current as an input, it has to be changed. For simplicity, 
the voltage of the motor is chosen as an input. The relation between the voltage and the current of a DC 
motor can be described as shown in Equation (5) 


u = R i + Lai + kw (5) 
where R, is armature resistance, La is the armature inductance, k, is the motor velocity constant and u and 1 
are the armature voltage and the armature current respectively. Since Equation (5) is a differential equation, 
it would add two further states to the dynamic model. This can be avoided if the dynamics of the current in 
Equation (5) are significantly faster than the fastest dynamic in Equation (3). This assumption is satisfied and 
the dynamics of the current can be neglected. This yields the following Equation (6) and Equation (7) 


u = Rit kw. (6) 


with these simplifications, the reduced dynamic model results to 





z vcos(@) 0 0 
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ki: 


T(0) = zo, y(9) = yo, (0) = o, v(O) = vo, w(0) = wo. (7) 


3.2.3. Model identification 
The goal of the model identification is to determine the unknown parameters in Equation (7). Since 


er l 
in Equation (7) parameters only occur on the right hand side of [č c] and these equations do not depend on 


[x y, w] , the dynamic model for the identification can be reduced to the states [v.w]" . Furthermore, 
the EE in Equation (7) are combined to one parameter vector. This yields the following model 
description for the identification with the parameter vector P 7 [P1 P2; P3: Pa: P5:Pel” | In order to 
identify the model, the velocity and the angular velocity needs to be measured. The eaae and 
the simulation with the identified parameters can be seen in Figure 3. 
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Figure 3. Simulation of the model with the identified parameters and the measurement 


For the identification, there are three experiments considered. The input signal is chosen as a step 
function, whereby each experiment has different nal values. These experiments are chosen as typical 
movements of the robot. The first experiment is a straight drive, the second experiment is driving a turn and 
the last experiment is driving a curve. In order to obtain the parameters, the model according to Equation (8) 


is simulated with a parameter vector Po, The velocity and the angular velocity from the measurements are 


calculated in parallel. The output of the model Ysim — (Usim: Wim! and the output of the measurements 


Ymeas f aaa Wmeas| are considered in a cost function. 


we 


J(p) = 9 S ((Umeas(ti) — Vsim| ti, p) + (Wmeaslti) m Waiml ti p) ) | 


i=] (9) 


Thereby M is the quantity of measured points. To minimize this cost function, a nonlinear optimizer using 
the simplex search method is used [35]. 


3.2.4. Speed controller 

The formation controller, which is considered in this work, uses the kinematic model in Equation (1) 
to obtain the control law for each robot. Since the input of the real robot is the duty cycle of the PWM signal 
of each wheel, it is not guaranteed that the current speed of each wheel reaches the desired speed. Therefore, 
it is necessary to implement a speed controller for each wheel. For this purpose, a simple PID controller is 
considered. The input of the controller is the error between the desired speed and the current speed of each 
wheel. Equation (2) can be rearranged to obtain the desired speed from the velocity and angular velocity of 
the robot. The transfer function of the continuous-time PID controller is given by 





a - „1 i 
Gels) = Kp + Kı- + Kp 


with the control parameter Kp, Kr and Kp and the filter coefficient Ny. The parameters for the PID controller 
are obtained via a nonlinear optimization. The goal of this optimization is to minimize the integrated squared 
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error © — “des — "sim between the desired speed and the simulated speed. Therefore, the reduced dynamic 
model Equation (7) with the identified parameter is used. Since the input u of the motor is constrained, 
this constraint has to be considered in the optimization. To avoid slipping wheels, the acceleration of 


the robot is constrained as well as the angular acceleration. The constrained optimization problem is given by 


T 
min e?dt 
Kp, Ki Ko Jp 


subject to |u| — tma: <0 


(11) 


with the maximum voltage of the motor Umax, the maximum acceleration amay and the maximum angular 
acceleration amax. For the implementation of the PID controller, the continuous-time controller has to be 
transformed into a discrete controller. This is done by means of zero-order hold discretization. Robot 1 is 
the leader and robot 2 is the follower. The goal is to maintain the relative distance and the orientation 
between the leader and the follower. Figure 4 is illustration of the leader follower constellation. 





Figure 4. Illustration of the leader follower constellation of the | controller according to [20] 


4. FORMATION CONTROL APPROACHES 
In this section, two given formation controllers are outlined and the control laws are presented. 
Furthermore, a new approach to avoid a collision based on a formation controller is proposed. 


4.1. '— ® controller 


The !— controller is proposed in [11]. This controller uses the leader-follower approach, whereby 
the relative distance and the orientation between the leader and the follower are controlled. This approach 
uses the techniques of input/output linearization to achieve the formation controller. Figure 4 illustrates 


the leader and the follower robot with the controlled values !!2 dan “2, The aim of the ! — ¥ controller is to 
d 
maintain the desired length liz and the desired relative angle Wie while the leader is following a given 


trajectory. Thereby, the state of the follower is defined as (ha, viz. dal 
The kinematic relationships of Robot 1 shown in Figure 4 are given by Equation (1). The kinematic 
relationships of Robot 2 are given by 
— cos(y1) — m cos(a) + cw sinf y ) 
Yu = z (M sin(viz) — m sinf) + ovac) — haan) 
12 


$2 = wh; (12) 


Investigation of Formation Control Approaches Considering the Ability of a ... (Hannes Wind) 


24 o ISSN: 2089-4856 


according to [20], with 7! — Pı + Piz — P2. t is required that l2 > Čin order to avoid a collision. 
The use of input-output linearization yields the following control law for the follower: 


cosi yil p, PE ; a Se. A 
Wz = — ilal 12 (wi — Pia) — vy sin(yy2) + lawi + pia sin(71))} 
Ug = piz — Qv2 tanf yi) (13) 
where 
pP a (If) — l12) + vı cos(y12) 
Iz — - : 
cos(y1) (14) 
with these inputs, the [—wa variables become 
he = ay (i — h2) 
he, — neal E 
Piz = aa (Yiz — Viz) (15) 


whereby Equation (13), Equation (14) and Equation (15) according to [20]. In order to calculate the control 
law in Equation. (13), the length liz and the angle “’!2 are required. These can be calculated as 


"hs = Tp = (‘p. + ! Ry ` ol) 


fe = I hil 


‘im, ef (Iba) 
Wiz = arccos | sf i ma 
[Rve (Gell 


(16) 


with 


Ip. _ cœ) —sin(@;) PE OH 
Ry, = prs, cos(ġ;) |. — ies e = 10 


(17) 
where ‘Rv; is a transformation matrix which transforms a vector from the coordinate system V; into 
the inertial coordinate system J and Jp; is the position vector of the robot 1 referred to the inertial coordinate 
system. This vector contains not the full state of the robot 1, but only the position (x; yi). 

To be able to calculate the control law in the follower robot, the whole state of the leader ql, 
the whole state of the follower q2 and the input signals of the leader \"1-“1) are needed as well as the angular 
velocity of the follower “2 From this, the communication between the leader and the follower can be 
determined. 


4.2. !—! controller 

The ! — ! controller is proposed in [20]. This controller also uses the leader-follower approach with 
the difference of two leaders and one follower. The aim of the !—!controller is to control the distance 
between the follower and the two leaders. 

Figure 5 illustrates the two leaders (Robot 1 and Robot 2) and the follower (Robot 3). The controlled 
values are the distances between the leaders and the follower /73 and 23. The aim of this controller is to 


Ta] : 
maintain the desired lengths ls dan la while the leaders follow a given trajectory. Thus, the state of 


IT , 
the follower is given as llis: ł23: #3] The requirements for the ! — l controller concern the lengths /73 and l23. 
It is required that those lengths are greater than the distance c and the follower must not lie on a line 
connecting the two leaders [20]. 
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The kinematic relationships for the leader robots shown in Figure 5 are given by Equation (1). 
The kinematic relationships of the follower are given by 


lia = vy cos( 71) — V1 cos{ Yig) + cwsg sinf y) 


P, 
=- 


lag = va c08(72) — vfcos(Ųzs) + cws sin(72) 

Q3 = Wy (18) 
according to [20], with ™ ti + Vis — pai = 1,2, 
The use of input-output linearization yields the following control law for the follower 





Figure 5. Illustration of the leader follower constellation of the l — l controller according to [20] 


i E N rel i eld T — el Sel E E 
ale a (līs — la) co8(72) + vı cos(a) cos(-y2) — aafl33 — 123) co8(71) — v2 cos(yz3) cos(y,)} 
i (If — lia) + v1 cos(Yia) — ews sin(y1) 


cos(")1 ) (19) 
with these inputs the l —I variables become 


hs = ay (IS, = lis) 


loz = a(I$3 — lz3) (20) 


whereby Equation (19) and Equation (20) defined according to [20]. The calculation of the current length ITs 


and 135 follows Equation (16). To calculate the control law in the follower robot, the whole state of the two 
leaders gi and q2, the whole state of the follower q3 and the velocity of the leaders ¥; and v are required as 
well as the angular velocity of the follower “'3. Considering this information, the communication can be 
determined. 


4.3. Collision avoidance controller 

Following, an extension of the! — controller from Section 4.1 is proposed. The goal of this 
extension concerns the collision avoidance based on local sensors. First of all, static obstacles should be 
recognized by the local PSD sensors. Using this measurement, a defined safety distance to a static obstacle 
should be maintained. Furthermore, a collision with other robots in the formation needs to be avoided. 

For the collision avoidance controller, a formation with one leader and N followers is considered. 
This formation is controlled by a! —W controller. To be able to avoid a collision, the desired control values 


Ms and Vie (i= 1,2,- N)are changed in an appropriated manner. This implies that the desired values are time 
dependent. Therefore, the following algorithm for changing the desired values and hence the formation 
is proposed. 
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E = kı iy] 
we = kyu 
I¥;(0) = Fiw wi, (0) = Vio: (21) 
with 
i, i(PSD,<e, and PSDpr <er) or (PSDp< er) or 
npa (PSD, >e, and FPSDpr>er and FSDpr>ep and i < Ma) 
1 ) -1, if(PSD, >e, or PSDp>eg) and FSDp>ep and l4 >it, 
0, else, 
l, W{FSDL <e, and FSDpR>ep) or 
(PSDL>e, and PSDr>egr and yt < yh) 
uy=4{ —1, if(PSDL>e, and PSDR<eR) or 
(P 5 D, = EL and f 5 Dg > ER and pi = aa ) 
0, else, (22) 


where subscript L, R and F refer to the left side, the right side and the front, respectively. The symbol PSD 


denotes the value of the PSD sensor and © specifies the threshold. The value of the measurement from 
the PSD sensors is related to the distance, 1.e., if the value is beyond a threshold, no threat concerning a 
collision exists. 


5. SIMULATIVE INVESTIGATIONS AND RESULTS 

In this section, the three formation controllers from Section 4 are investigated for the purpose of a 
possible implementation on the given robots. Specifically, several simulations of each formation controller 
are carried out with different models of the robot. These models are changed in an appropriated manner to 
achieve a more detailed model of the real robots. According to the results of these simulations, a conclusion 
is given regarding the possibility of implementing a formation controller on the robots. 


5.1. Considered simulation models 

Before the simulations take place, the different models for the simulation and different simulation 
environments are introduced. The models are changed from an easy kinematic model to a very detailed 
model which also considers communication. With these different models it is possible to gure out the crucial 
parts of the whole system concerning an implementation of the formation controllers on the real robots. 
These models are modelled and simulated in Matlab/Simulink. As a further simulation environment, EyeSim 
is introduced [36], [37]. 

As already mentioned, the first model will be a kinematic model as introduced in (1). The first 
improvement on the simulation model concerns the model of the robot. Instead of using the kinematic model 
of the robot on which the control design is based, a dynamical model is used. Therefore, the model 
Equation (7) of Section 3.2.2 with the identified parameters is used. Since the velocity V and the angular 
velocity * are not controlled in Equation (7), the speed controller of Section 3.2.4 is applied. Therefore, not 
only the optimized control parameters of the PID controller are used. With the change of these parameters 
and therefore the change of the performance of the velocity controller, some requirements on the speed 
controller can be formulated. 

To improve the dynamic model, a further characteristic of the robot is included. A crucial aspect 
from implementing a controller in hardware is the discretization. Due to the characteristic of a 
microcontroller, it is not possible to achieve a continuous output signal of the controller. The control output 
will therefore be a discrete signal. 

Due to the fact that these formation controllers need communication, the method and impact of 
communication is investigated. For this work, two types of error causes are considered. The first error results 
from network delays. There are many causes for these delays e.g. the limited network transfer rate or sending 
packages through several layers. In summary all these delays can be considered as an additional amount of 
time in the sampling time. The second considered error concerns the communication protocol UDP, which is 
used for transmitting data. This protocol is unreliable and there is no guarantee of delivery. Therefore, the 
model of the system is extended to cover the occurrence of package loss in the network. The event of a 
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package loss is assumed to be uniformly distributed and if one package is lost, the whole calculation of 
the controller is skipped in this sample. 

EyeSim is used as a second environment for simulating the formation controller [36], [37]. 
This program is a simulation environment for multiple mobile robots which provides the possibility to 
simulate different kind of robots [36], [37]. One of those robots is similar to the robots this paper takes as a 
basis. An advantage of EyeSim is the application programmer interface (API) which is the same as the API 
of the real robot. This means the whole functionality of the high level is provided in EyeSim. The relevant 
functionality for this purpose is limited to manipulating the speed of the robot, the communication between 
robots and the retrieving of the sensor data. The use of EyeSim is also a good opportunity to check 
the control law in combination with the highlevel functionality. Figure 6 is visualization of the !—- ¥ 
controller with a kinematic model. The Robot 1 is denoted as +, Robot 2 as o and Robot 3 is denoted as *. 


y in m 





r m m 


Figure 6. Visualization of the ! — ¥ controller with a kinematic model 


5.2. Simulations of the ! — ¥ controller 
In this subsection, several simulations firstly with Matlab/Simulink and secondly with EyeSim are 
carried out. Finally, the applicability to implement this ! ~ ¥ controller is discussed. 


5.2.1. Simulation in Matlab/Simulink 
The first simulation of the!— ¥ controller is done with the kinematic model to investigate its 
behavior. Therefore, a constellation with one leader and two followers is considered. The leader drives a 


curve with the input values Vy = 0.1 and “r = 0.1. The formation specification for the first follower is defined 


d ña ,,d — 947 : d — 03. 4h = 150° 
as iz = 0.3, Viz = 210°and for the second follower the desired control values ares = 0-3, Wis = 150" 


The initial pose for each robot is the control parameters are chosen as@1 = Ü.5 and @2 = 0.5 as shown in 
Equation (23). 


q,(0) = H 
7 lo] 


The results of the simulation with the kinematic model can be seen in Figure 6. After an initial 
convergence of the two followers it can be observed that the desired length and the desired angle are 
maintained. The follower robot follows the leader with the specified parameters. 

The second simulation is carried out with a dynamic model as mentioned in 5.1. There are two 
crucial outcomes of these simulations. Firstly, the speed controller plays an important role in the whole 
system. If the velocity v and the angular velocity “’ of each robot do not converge to the required value, 
the behavior of the dynamic model is different from the kinematic model. In addition to this, the length li 


Pn es ee er 
| 0 | i 0 | (23) 


and the angle “1! (where i is the number of the follower) do not converge to the desired values, if the leader 
robot converges to the kinematic model and the followers do not converge. To achieve this goal, the integral 
part of the PID controller is necessary. Considering the method of determining the control parameters it is 
ensured that both the velocity and the angular velocity converge. 
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Secondly, the shape of the reference trajectory combined with the parameters of the speed controller 


has an influence on the convergence of the formation values, namely the length Ji and the angle Pli, 


If the speed controller is faster, the influence on a change in the reference trajectory regarding the formation 
values is less than with a slower speed controller. Therefore, a fast speed controller is required. This demand 
is covered by the proposed method of determining the control parameters. The results of two simulations can 
be seen in Figure 7. 


,||—— Cont. --- Disc. 10 Hz —— Disc. 0.5 Hz 


length lio in m 





angle ayo in rad 


“0 2 4 6 8 10 12 4 16 1 20 B M 3% % 30 


tins 


Figure 7. Visualization of the l — © controller with a dynamic model and a discrete controller 


The next simulation takes the dynamic model with the discrete controller as a basis. Since the network 
delays can be considered as an increase in the sample time, these delays will be considered here as well. For this 
purpose, a constellation with one leader and one follower is considered with the desired length lz = 0.3m and 
the desired angle%i2 = 210" The upper subplot visualizes the current length and the lower subplot the current 
angle. In each subplot, three simulations are shown. The first one uses a continuous l — © controller whereas 
the other simulations use a discrete controller, one with a sample frequency of 10 Hz and one with a sample 
frequency of 0.5 Hz, respectively. It can be observed that the controller with the higher sample frequency is close 
to the continuous one. A too low sample frequency leads to a non-converging behavior. This characteristic of 
the discretization has to be considered by the implementation of the control law on the high level. 

There are two outcomes of the simulations with the last improvement of the model regarding 
the package loss. Firstly, the stability of the !—W controller depends on the percentage of the package loss. 
If the package loss is very high (in this case beyond 80%), the stability is not further guaranteed. 
Nevertheless the system tolerates a huge amount of package loss, which is a positive result regarding 
the implementation. Secondly, the amount of tolerated package loss depends on the shape of the leader's 
trajectory. The more changes occur in this trajectory, the fewer lost packages can be tolerated to achieve an 
adequate performance. 


5.2.2. Simulation in EyeSim 
The results of the simulation show a similar behavior of the ! — “ controller to that obtained from 
the Matlab/Simulink simulations. Therefore, no diagram will be shown. 


5.2.3. Applicability 

Following, a summary of all the investigated situations concerning the implementation of the [— wo 
controller on the robots is given. If the speed controller is implemented as suggested in the Subsection 3.2.4, 
the formation can be achieved. Another point mentioned recurrently is the shape of the reference trajectory. 
This has to be chosen in an appropriate manner. Critical open points are the time demand on the robot for one 
execution of the control algorithm and the package loss in the network. If the suggestions mentioned in the 
section before are considered, it is possible to implement the l — W controller on the given robots. 
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5.3. Simulations of the l — ! controller 

In this subsection, several simulations firstly with Matlab/Simulink and secondly with EyeSim are 
carried out. Finally, the applicability of the l — l controller is discussed. The Robot 1 is denoted as +, Robot 2 
as o and Robot 3 is denoted as *. The results of the simulation can be seen in Figure 8. 
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Figure 8. Visualization of the l — l controller with a kinematic model, resulting from a simulation 
with Matlab/Simulink 


5.3.1. Simulation in Matlab/Simulink | 
The first simulation of the ! — t controller is carried out with a kinematic model. Therefore, a simple 


constellation with two leaders and one follower is considered. This controller can only deal with straight 
0 (i = 1,3) 


lines. For that reason, the input values of both leaders are chosen as v; = 0.1 and“! 
d 99 B =0.4 aes 
The formation specification for the follower is defined as tis = 0.3 and ne The initial pose of each 


robot is given by 


D| Ù 
q(0) = [0| ,q2(0) = |-0.4| a40) 
ol 0 





(24) 


and the control parameters are chosen as a, = 1 and œ = 1. 

The results of the simulation can be seen in Figure 8. After an initial phase of convergence, 
the formation is maintained with the defined formation specification. In the further simulations the setup 
considering the initial pose, the desired values and the leader's trajectory will be the same as in the simulation 
of the kinematic model 

The first simulation beyond the kinematic model is to simulate the !—! controller with a dynamic 
model. The crucial outcome of these simulations concerns the speed controller. The requirements for 
the speed controller correspond with the demands in the Subsection 5.2.1. It must have a converging behavior 
considering the velocity v and the angular velocity =. Since there is no change in the leaders’ reference 
trajectory, the demands regarding the transient time are not as strict as for the !—W controller. 

In the next simulation, different sample times are considered. In Figure 9, the results of a simulation 
with a sample frequency of 10 Hz and 1 Hz can be seen. For comparison reasons, a simulation with a 
continuous !—! controller is also visualized. Considering the higher sampled controller, it can be observed 
that the current length is close to the current length of the continuous controller. In fact both are converging 
to the desired length. As opposed to this, the | 1 controller with a sample frequency of 1 Hz shows an unstable 
behavior. Comparing the behavior of a discrete !—W controller and a discrete !—! controller, it can be 
observed that the !—! controller tends to an unstable behavior earlier as the !— ¥ controller, when 
the sampling frequency is decreased. These properties of the !—T controller need to be reconsidered in 
the implementation of the controller. 

The delay in the network communication is considered as an additional discrete delay as in 
Subsection 5.2.1 Therefore, The Next Investigation Considers The Package Loss In The Network. Several 
simulations with different percentage of package loss are performed. The crucial outcome concerns 
the tolerated amount of package loss. The more packages are lost, the longer it takes to converge to 
the desired formation. This is valid until a certain amount of package loss occurs. Beyond this point, 
the !—! controller becomes unstable. 
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5.3.2. Simulation in EyeSim 


Since the results of the simulation show a similar behavior of the !— ® controller to that obtained 
from the Matlab/Simulink simulations, no diagram will be shown. 
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Figure 9. Visualization of the controller with a dynamic model and a discrete controller 


5.3.3. Applicability 

The results discussed above are reconsidered in order to summarize the investigation of the l—i 
controller. In comparison with the [—yp controller, the demands on the speed controller are less restrictive. 
However, the requirements on the sample time are higher. This is not a disqualifier, since the sample 
frequency is very low when the instabilities occur. Nevertheless, the execution time of the control algorithm 
including all other necessary executions must be considered during the implementation. Furthermore, 
the occurrence of a package loss has to be reconsidered for the implementation. This is covered with 
the investigation of the !—W controller. 


5.4. Collision avoidance controller 
In this subsection, simulations with the collision avoidance controller are carried out. The simulation 
in Matlab/Simulink is skipped for the collision avoidance controller for two reasons. Firstly, this controller 


has the !— controller as a basis and is has already been investigated with an extended model in 
Matlab/Simulink (see Section 5.2.1.). Secondly, the collision avoidance controller uses PSD sensors. EyeSim 
provides a realistic behavior of the PSD sensors. This also includes the measurement of the distance to 
another robot considering the appearance of it. For these reasons, only a simulation in EyeSim is performed 


5.4.1. Simulation in EyeSim 
The first simulation concerns the static obstacle. Therefore, a constellation with one leader and two 


if = 0.4, 04, — 150° 


followers is considered. The formation speciation is defined as for the first follower and 


its = 0A, Yis = 210° for the second follower. The initial pose is given as 
0 —().5 —0.5 
gı (0) 0j .g-{0) 0.4 | gil) ü 
0 


0 0 (25) 


The simulation setup is chosen as follows. The leader performs a straight line with two followers. 
After a de ned distance, an obstacle occurs for a certain length. This obstacle forces the second follower to 
change its position. The results of this simulation can be seen in Figure 10. It shows the position of each 
robot to certain time steps. It can be observed, that the second follower is changing the position to maintain 
the desired minimum distance to the obstacle. The change appears firstly in the angle until the distance to 
the first follower is under a threshold. After that, the desired length is increased. If the formation passed 
the obstacle, it returns to the initial formation. This simulation does not show an avoidance of a collision, 
since the obstacle is not a potential collision. But it demonstrates the possibility to maintain a specified 
distance around each robot based on the PSD sensors 
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Figure 10. Visualization of the collision avoidance controller with an obstacle on the right, 
resulting from a simulation with EyeSim 


The corresponding current length /;3 and current angle © |; of the second follower can be seen in 


Figure 11. Additional to this, the desired formation parameters lfs and Vis are plotted. The situation 
according to the change in the desired formation parameters can be observed as described above. 
Furthermore, a converging of the current length l;3 and current angle W ;; to the desired ones can be seen. 
The Robot 1 is denoted as +, Robot 2 as o and Robot 3 is denoted as 
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Figure 11. Visualization of the formation specification of the collision avoidance controller 
with an obstacle on the right, resulting from a simulation with EyeSim 


A further simulation considers the collision avoidance with two robots. Therefore, a formation 
constellation with one leader and two followers is considered. In difference to the simulation before, 
this simulation uses the same formation parameters for each robot. They are defined as 


d E Fal 1S Io i E S 
Fie = 0.8 and qh, = P a _ 1 2) with the initial pose 
0 —0.5 —0.8 
q,(0) = | 0} ,q.(0) 0 | ,q,(0) 0 
0 ü ü 


(26) 


The leader is performing a straight line and the follower robots are trying to follow this line at 
the same position. Since this is physically not possible, the collision avoidance controller is taken into 
account. The results of this simulation can be seen in Figure 12 and 13. Once the second follower gets closer 
to the first follower, the desired length is increased according to the algorithm in (22). Hence, no collision 
occurs. This new formation is maintained while the second follower has a new desired length. 
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5.4.2. Applicability 
The simulations show the possibility of maintaining a defined distance on each side of the robot and 


the ability of avoiding a collision. If the crucial parts in Subsection 4.1 are considered for the l-4 
controller, an implementation with these specifications is possible. 
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Figure 12. Visualization of the current length and the desired length of the follower two with the collision 
avoidance controller, resulting from a simulation with EyeSim 
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Figure 13. Measured length lı2 and angle12 of the first experiment with the l=% controller 


6. EXPERIMENTAL RESULTS 

In this section, the experimental results are discussed. This is basically done for each controller 
itself. Since the ! — “ controller was the first implemented controller, these studies are more extended and 
in some point more general than the others. 


6.1. Experiments of the !—W controller 

In order to gain a first impression of the connected real system, a simple experiment with one leader 
and one follower is considered, whereby the leader performs a straight line. The formation specication is 
it, = 0.3 and y, = 18h 


dened as with initial pose 
0 —0.45 
qı (0) ql 4210) | a | 


(27) 


The results can be seen in Figure 13. It can be observed that the current length is converging to 
the desired length after a settling time. The increasing length at the beginning of the experiment is caused by 
the static friction of the robot. Since the leader has a step function in the velocity v, the robot can overcome 
the static friction faster. Furthermore, the desired velocity of the follower, resulting from the formation 
controller, is relatively low. Thus, it takes longer to overcome the static friction. For the angle V i2 this 
behavior cannot be observed, since the initial pose of the leader and the follower already fulfill the desired 


angle. Nevertheless it can be seen, that the desired angle is maintained with a certain range during this 


experiment. 
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The second experiment considers one leader and two followers with the following formation 


d Fs 
la = 0.3 and the desired angle is defined as 


0.3, oi, = 210° 


specification. For the first follower the desired length is 


E nal RF š pe ; š g5 
Wiz = 150" Whereas the formation specification for the second follower is chosen as fis 
The initial pose of each robot is defined as shown in Figure 14. 
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Figure 14. Measured length and angle between the leader and the two followers of the second experiment 
with the ! — ¥ controller 


In Figure 15, the formation of the three robots can be seen. For reasons of clarity and 
comprehensibility, this gure only shows the straight line. The convergence behavior as described above is 
clearly visible. Furthermore, the maintaining of the formation while performing a straight line is 
recognizable. 
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Figure 15. Visualization of the formation of the second experiment with the controller 


0 —0.45 —0.45 
q, (0) O} .go(0) 0.35 | ,q,(0) 0 
0 0 0 


(28) 


The leader performs a straight line for one meter with a constant velocity. After the straight line, 
the leader performs a circle with a radius of 0.25 m and an angle of 180°. The current length /j2 and lz3 of 


both follower as well as the current angle *!? and Wis are shown in Figure 14. It can be seen that the current 


length and the current angle are converging to the desired ones. At the time t = 2.3s the current length of both 
follower increases until 2.5s. This is the point in time when the leader changes from the straight line to 
the circle. Thus, the followers need to converge to the desired length again. The difference in the current 
angle is not as significant as the difference in the current length. 
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6.2. Experiments of the controller 
The first experiment considers a constellation with two leaders and one follower. Both leaders 


perform a straight line with the input values“! ="! and wi = U (i = 1.2) The formation specification for 


I ii = 04 and ii = 0A. e — 
the follower is chosen as . with the initial pose of each robot as shown in Figure 16. 


0 0] —0.45 
q(0) = |0| -g2(0) = |04| ,g{0) 0.15 
0 0 0 


length ha in m 





length fos in m 


1.6 
tins 


Figure 16. Results of experiments on real robots with the !—T controller 


Figure 17 visualizes the formation. It shows that both leaders perform a straight line while 
the follower maintains the desired lengths and thus the formation. The initial convergence to the specified 
formation as described above can be seen as well. The Robot 1 is denoted as +, Robot 2 as o and Robot 3 is 
denoted as *. The results can be seen in Figure 16. It can be observed that the current length /;3 and l23 are 


d aA 7d 
converging to the desired length M3 and fos after a settling time. These desired lengths are maintained during 
the whole experiment, as required. 
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Figure 17. Visualization of the formation of the ! — ! controller on the real robots 


6.3. Experiments of the collision avoidance controller 

The setup of the experiments which are performed for the collision avoidance controller are similar 
to those in Subsection 5.4.1. The first experiment considers a static wall on the right side of the robots. 
Therefore, a constellation with one leader and one follower is considered. The formation specification 1s 


if, = 0.3 and y$ = 180° 


defined as with the initial pose. 
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The current length and the desired length as well as the current angle and the desired angle can be 
seen in Figure 18. Typical for the collision avoidance controller is the change in the desired length and 
desired angle. It can be observed that the current length and the current angle are close to the desired values 
with a bit of a time delay. These results are expected from the simulation with EyeSim in Subsection 5.4.1. 
The occurrence of the static obstacle on the right side can be seen at time t = 2.5 seconds. At that time a 
significant change in the desired angle can be observed. The angle is decreasing until t = 4.3 seconds. 
Subsequently, the robot overcomes the obstacle and the desired angle increases until the current angle 


ud 
reaches the initial angle “~!*". 
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Figure 18. Results of experiments with the collision avoidance controller on real robots with an obstacle 
on the right 


In Figure 19 a visualization of the formation can be seen. It can be observed that the follower is 
changing its position when the obstacles occur. Thus, a specified minimum distance to the obstacle is 
maintained. After the follower passes the obstacle, the desired angle changes back to the initial one. 
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Figure 19. Visualization of the formation of the collision avoidance controller on real robots with an obstacle 
on the right, The Robot 1 is denoted as+and Robot 2 is denoted as o 


The second experiment concerns the avoidance of a collision with a robot to its front. This one is 
similar to the experiment in Subsection 5.4.1., with one leader and two followers. These two followers are 


i. = 0.3 and f = 180° (i = 1,2) 


trying to achieve the same formation, which is defined as ‘with the initial 


pose. 
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The collision avoidance controller considers the distance to another object, measured by the PSD 
sensors. For practical purposes, another safety feature is added. If the measured distance is below a critical 
distance, the robot is forced to stop. This method is necessary at the beginning of the experiment due to 
the initial position of the second follower. Therefore, the speed at the beginning is too high to stop the robot 
with the collision avoidance controller. The results of this experiment can be seen in Figure 20. Due to 


the fact of another robot being in front of the follower two, the desired length lfs is increased. After the 
safety distance is maintained, the robot achieves a new desired length. With this desired length, no collision 
occurs. The stopping of the robot can be observed at the beginning of the experiment as a decreasing and 
increasing of the current length. 
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Figure 20. Current length and desired length of the follower two 
with the collision avoidance controller on real robots 


7. CONCLUSION 

This paper investigates formation controllers for the practical implementation on given robots. 
An existing parametric dynamic model is used as a basic model for the investigation of different formation 
controllers. A model identification is performed to obtain the parameters of the dynamic model. Based on this 
model, the parameters of the PID controller for the speed of each wheel are determined. After introducing 
the considered formation controllers and proposing a new collision avoidance controller, several simulations 
are carried out. Studying the results of the simulations, certain requirements concerning the implementation 
can be imposed. Crucial requirements are that the velocity controller is fast enough and that the trajectory of 
the leader has to be planned concerning the ability of the robots. 

Considering all these demands, the implementation is performed successfully. The results of 
the experiment show a similar behavior to the simulations and thus validates the simulations. The successful 
implementation and experiments show the ability of applying a formation controller on real robots which was 
developed for a kinematic model of a mobile robot. In addition to this, it shows that the given mobile robots 
are able to perform a formation with these formation controllers. The results of the collision avoidance 
controller show the ability of maintaining a safe distance to an obstacle and avoiding a collision. 

The simulation models developed in this work can be used for further investigations of formation 
controllers for the application on real robots. With these models, it is possible to verify the ability of 
implementing a formation controller on real robots. Critical parts of the implementation can be determined 
and appropriate improvements can be carried out. A further improvement involves the dynamic model of 
the mobile robot. This dynamic model can be extended to consider the friction of the castor. Therefore, 
a suitable friction model should be chosen. In addition to that, new formation control approaches can be 
considered, such as a model predictive control approach. Since this controller requires high computational 
power, investigations should occur to assure sufficient amounts of computational power prior usage. The last 
improvement includes the collision avoidance controller. The ability of maintaining a desired distance to a 
static obstacle laterally can be extended to avoid obstacles in front of a robot. Therefore, the robots ability to 
sense obstacles in front has to be considered. 
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